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Применение робототехники 
для обследования шахты после обвала 


Проанализированы реальные задачи, высокоактуальные для повышения безопасности в отечественной 
угледобывающей отрасли промышленности с точки зрения поддержки горноспасательных работ 
средствами интеллектуализированной робототехники. Рассмотрены некоторые вопросы создания 
программно-аппаратной части моделирования и функционирования роботов ДЛЯ обследования завалов и 
аварийно-опасных участков в шахтах. 


Введение 


После известных событий 1991 года угольная отрасль Украины практически не 
получала ощутимых инвестиций по модернизации используемых технологий конца 
ХХ века. Специалисты считают, что именно это является одной из главных причин 
непрерывного роста аварийности на отечественных шахтах. Анализ показывает [1], 
что для выхода отечественной угольной отрасли из нынешнего критического состояния 
одной из наиболее актуальных проблем является создание высокотехнологических 
средств предотвращения аварий, включая создание и применение на шахтах интел- 
лектуализированных роботов-разведчиков (ИРР) для контроля текущего состояния 
аварийноопасных участков и для участия в горноспасательных работах после аварий. 
Создание ИРР актуально для угледобывающей отрасли не только Украины, но и для 
других стран ближнего и дальнего зарубежья. 

Постановка задачи. В связи с актуальностью создания ИРР для угледобыва- 
ющей отрасли авторы на ряде совещаний со специалистами горноспасательного дела 
(включая ведущих специалистов НИИ горноспасательного дела и пожарной безопасности 
Минуглепрома Украины) и ведущими инженерами шахты им. А.Ф. Засядько проанализи- 
ровали реальные задачи, высокоактуальные для повышения безопасности в отечест- 
венной угледобывающей отрасли промышленности с точки зрения поддержки горно- 
спасательных работ средствами интеллектуализированной робототехники. 


Требования к создаваемой робототехнике 


По результатам совещания были приняты следующие общие требования к созда- 
ваемой робототехнике (условное название: «Горноспасательный интеллектуализи- 
рованный робот-разведчик (ГОСИР)»): 

1 Основные модули робота-разведчика ГОСИР: 

1.1 Шасси, двигатель с пневмоприводом для исключения электрооборудования, 
несущего риск электроискрения, что может привести ко взрыву в метанопылеугольной 
атмосфере шахты. 
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1.2 Набор бортовых сенсоров для контроля шахтной атмосферы (метан, угле- 
кислый газ, угольная пыль, кислород, угарный газ, влажность). 

1.3 Комплекс дальномеров для обследования и создания ЗО-модели обследуемого 
шахтного завала. 

1.4 Бортовой навигационный комплекс, обеспечивающий роботу возможность 
двигаться автономно и в соответствии с поставленной программой (маршрутным 
заданием) при использовании данных 3ЗО-мониторинга (пункт 1.3). 

1.5 Бортовой радиотехнический комплекс связи, обеспечивающий радиосвязь с 
удаленным оператором для консультаций в нестандартных ситуациях. 

1.6 Бортовой манипулятор для выполнения в необходимых случаях работ по 
созданию узких технологических проходов или «отверстий» в завалах пород путем 
бурения для последующего оказания помощи горнякам, застигнутым обвалом, включая 
передачу медикаментов, средств связи, продуктов питания, воды, пакетов индивиду- 
ального или коллективного спасения и др. экстренной помощи. Манипулятор должен 
обеспечивать также возможность выполнения операций по захвату объектов ограни- 
ченного веса (пробы пород, компоненты разрушенного оборудования и др.). 

2 Функции бортового программно-аппаратного комплекса: 

2.1 Контроль шахтной атмосферы. 

2.2 Распознавание исходной полученной бортовыми сенсорами мониторинговой 
информации. 

2.3 Принятие целесообразных решений в автономном режиме. 

2.4 Формирование З)-поверхности обследуемой зоны. 

2.5 Нанесение на ЗО-поверхность обследуемой зоны препятствий, узких и 
непроходимых роботом зон. 

2.6 Формирование файла состояния шахтной атмосферы с координатной привяз- 
кой к стартовой неподвижной системе координат. 

Требования к ГОСИР первого поколения (проект ГОСИР-1) включают обеспе- 
чение функций 2.1 и 2.2, связь с оператором происходит по радио или в отдельных 
случаях — по кабелю. Технические решения отдельных элементов ГОСИР первого 
поколения приняты в соответствии с пунктами | - 1.6. 

Построение математической модели по данным 3ЗО)-мониторинга предлагается 
осуществить с помощью 4-лучевого лазерного дальномера (рис. 1), описанного в нашей 
работе [2]. 


Рисунок 1 — По положению следов четырех зондирующих лучей на удаленном 
препятствии (зарегистрированных бортовой камерой на фото/видеоизображении) 
можно вычислить удаленность и ориентацию по двум углам участка препятствия, 

аппроксимированного двумя треугольниками, изображенными пунктирными линиями 


Программно-аппаратная часть интерпретации достаточно подробно описана в 
нашей работе [3]. Исходный файл данных (Оо! 30), который получается в результате 
измерения расстояний до препятствий дальномерами, записывается в память бортового 
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компьютера. Файл По ЗО далее используется специальной программой РКМ ЗО, 
которая аппроксимирует тем или иным математическим агрегатом точечно заданную 
поверхность и формирует ЗО-образ обследуемого помещения. Программа ОРТИМ_ТКА] 
формирует совместно с программой РВЛИМ ЗО варианты оптимального маршрута 
робота с учетом наличия препятствий и узких мест. 

Варианты сплайнов для движения самого робота можно получить, используя 
программу РК!ИМ_ ЗО, моделирующую обследуемую поверхность конечными элемен- 
тами. В большинстве случаев достаточно получить аппроксимацию в форме кусочно- 
плоской поверхности, составленной из множества соприкасающихся призм или как 
пересечение пространственных плоскостей. 

В более сложном случае (например, при выполнении отверстий в породе специ- 
альным бортовым буром из пункта 1.6 требований) необходимо воспользоваться 
программой ЗО _ЗРИЛМ№Е, обеспечивающей построение непрерывной вместе с первой 
производной поверхности, основанной на трехмерной сплайн-интерполяции. 

Для разработки типовых ИРР рассмотрены методы построения траектории 
мобильного робота с механическим многозвенным манипулятором для подбора опти- 
мальных параметров звеньев на уровне компьютерного имитационного моделирования 
для задач функционирования в ограниченных пространственных условиях шахты. 
Решение этой задачи является актуальным для проблемы разведки в шахтном забое 
или проведения ремонтных работ в узком помещении инженерного сооружения [1]. 
Типичный пример обследования: разведка интерьера инженерного сооружения после 
аварии, когда возникает дополнительная проблема обследования принципиального 
изменения интерьера (как результат аварии) сжатого рабочего помещения при неиз- 
вестной новой конфигурации возможных проходов. 

Таким образом, ГОСИР поставлена многокомпонентная задача, состоящая из 
взаимосвязанных частичных задач: 

1) пройти внутрь шахты; 

2) построить З)-карту «обновленной» местности; 

3) правильно выгнуться нужными шарнирами манипулятора; 

4) найти и захватить (или включить/ выключить) нужный предмет. 

Целью имитационного моделирования является расчет ряда типичных примеров- 
ситуаций для выбора количества, длины звеньев и углов ориентации системы упра- 
вления манипулятора и для обучения пользователей работе с устройством. 

Имитационное моделирование предусматривает решение таких задач: 

— поиск оптимальной длины сегмента манипулятора; 

— определение траектории захвата манипулятора для известной заранее конфи- 
гурации туннеля. При перемещении звеньев манипулятора и его захвата следует 
придерживаться построенной траектории, проходящей в центре туннеля; 

— реализация движения захвата манипулятора по построенной траектории при 
известной заранее конфигурации туннеля; 

— реализация движения захвата манипулятора методом проверки столкновений 
сферы безопасности с поверхностями туннеля на каждом шаге. Если столкновение 
произошло, тогда осуществляется поворот звена манипулятора. Этот метод используется, 
когда конфигурация туннеля заранее не известна; 

— определение углов шарниров на каждом шаге. 

Далее описаны 2 метода построения пути манипулятора сквозь туннель, исполь- 
зующие кубические сплайны. Эта задача актуальна для движения конечного звена 
многозвенного манипулятора, который несет сенсоры в сжатом, узком пространстве, 
типа аварийного штрека шахты после обвала пород. 
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Методы построения траектории на основе 
кубических сплайнов 


Метод /[. Классический. 


6п 


Имеется матрица размерности М, заданы значения для х и у при 1 = 0...М. 


Имеем й, ЕХ, -Х, для КЕ=1...М-1. Для того чтобы найти значения функции, в 


виде которой строим сплайн: 5, = ах’ +Ьх* +сх+4, где К=1...М-1, выполним 


следующие действия: 
1 Заполним матрицу размерности № х №Мзначениями 


27 И. 9 к. '9 0 0 

т м 0 0 

О ь, 22 Зе + 0 0 
[и, |= › 

ооо 2, Инь 1 


00 0х м 2 


где ДЕ, +)", ЕР А,+й},1=0,М. 


Для Л, и д, получить значения из данных формул невозможно. 


2 Поскольку 


21 


М питье 
УА,М, =4,,1=0,М, А, = А, (Я мн; М, А), 
1=0 


находим значения для 


я 6 (кн ЕТУ 
(Е 
Й, +Й. Й Й, 


Для равномерной сетки имеем: 


па 3 Уа-2 У + Ув 
К 9 . 
2 й 


3 Находим обратную матрицу А”. 
4 Находим М › где К =1...М-1. 


—1 
Для этого перемножим матрицы: М = А.Д ‚то есть: 
М2 
ы 
М. =У'ар,-а,. 
0 
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(п) 


(2) 


(3) 


(4) 


(5) 


ОЭ 
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5 Найдем Му и М у по формуле: 


а й М д, +М Ой, м Ио, | —2 (6) 
ь й, + Й, 6 й. й. й, +й, )` 


И) 7-1 


Для М, берем /=1, для Мм берем 7 =М-1. 
6 Находим коэффициенты необходимой нам функции на всех интервалах и 
строим сплайн: 


5. =ах’ +Ьх” +сх+А ‚тде К =1...М-1 (7) 
Коэффициенты: 
М.-мМ, 

а, (8) 

би, 
ь М х,-М ох, 9) 

21, 

_Мха-М ху (МАМОЙ, у,-У 
2 АОИ ОБИ и 
1 } 

ры М = М ‚ху й (Мох, - = ах й) е тт У. 1) 


Л И 


Иногда для построения гладкого сплайна достаточно использовать метод 2 [4]. 
Метод 2. Улучшенный метод 2. 


Доказано [5], что для ® <2 и н я <2 решение системы (2): 


М ить, 
УА,М, =@а,,1=0,М№, 


150 


А, = А’(» ин; М, А), 
существует и оно единственно, и при этом трехдиагональная матрица А = А(.., Их; М, А) 
неособенная, то есть имеет единственную обратную матрицу А". {1 р и вычисление 


№ 
моментов [м ) } осуществляется эффективно с помощью компьютера методом прогонки. 


Вместе с тем для изучения разрешимости поставленной задачи сглаживания выпуклыми 


кубическими сплайнами при оптимизации концевых условий необходимо получить 
= КИ М 
явное представление для всех элементов матрицы А”' как функций переменных {у } ь 


М > 
{п } при заданном №. В работе [4] изложен и обоснован один эффективный метод, с 


—1 
помощью которого все элементы матрицы А’ размерности М№Мх М представлены через 
элементы аналогичных матриц меньших размерностей № х № и № хМ,, причем 
№ + №, = М +1. Последовательное применение этого метода несколько раз позволяет 


свести задачу об обращении трехдиагональной матрицы А высокой размерности к 
простой задаче об обращении одной либо двух матриц малой размерности. 
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Критерии качества 


Критерии качества моделирования некоторой гладкой кривой только по значе- 
ниям этой кривой в конечном числе узлов интерполяции у; = Г (х;) таковы: 


Хм 
1. Обеспечение минимума: | Г"одах — > ти при всех вариациях М№и Й;; 


хо 
2. Для задачи интерполяции некоторой «идеальной кривой» набора Г, (х) на сет- 
ке @:х, <х, <...< ху так выбрать свой интерполяционный агрегат (кубический сплайн 


того или иного автора), чтобы при построении с помощью выбранного метода «своей» 
модели функции Ё(х) было выполнено следующее условие: 


|. - Е 


с 3 1, 


где [ — степень гладкости, 5, — заданная достаточно малая величина требуемой ТОЧНОСТИ 


аппроксимации, С’- класс кривой, непрерывной в /-й производной, / = 0,1,2. 
Сформулировано эмпирическое правило: 
1) для моделируемой кривой получить достоверные значения у, = Г(х,)в наи- 


большем количестве точек №М+1 из возможного числа; 

2) получить некоторую обучающую выборку в форме некоторого количества 
«идеальных» кривых, пригодных для данной предметной области. 

То есть А штук гладких кривых, описываемых аналитическими функциями на 
всех внутренних отрезках интерполяционной сетки @:х, <х, <...<Х»у. 


Задачей интерполяции заданной гладкой кривой (то есть из класса С ыы непре- 
рывной с 1-й производной) называется задача построения некоторой функции из 


класса С' при выполнении условия у, = /(х,), где значения у, в узлах сетки 


@:Х <х, <... < ху считаются только заданными. 


Выводы 


В работе проанализированы реальные задачи, актуальные для повышения 
безопасности в отечественной угледобывающей отрасли промышленности путем 
применения средств интеллектуализированной робототехники для поддержки горно- 
спасательных работ. Рассмотрены некоторые вопросы создания программно-аппарат- 
ной части моделирования и функционирования роботов для обследования завалов и 
аварийно-опасных участков в шахтах. 

Приведено сравнение двух методов для построения пути многозвенного ма- 
нипулятора сквозь туннель, использующие кубические сплайны. Методы являются 
элементом САПР для создания многозвенных роботов — манипуляторов, способных 
за счет комбинированного взаимодействия звеньев во времени и пространстве дви- 
гаться вдоль траектории, обеспечивая минимальное отклонение от оптимальной 
идеально гладкой кривой. 

Для аппроксимации полученных сплайн-функций с целью построения траек- 
тории манипулятора интеллектуального робота следует использовать второй усовер- 
шенствованный метод. Он имеет уменьшенное количество операций расчета без 
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снижения точности за счет сокращения количества шагов прогонки матрицы в два 
раза. Метод позволяет записать алгоритм управления углами шарниров манипуля- 
тора на бортовой компьютер системы управления интеллектуальным роботом. 
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В.Г. Писаренко, Ю.В. Писаренко, К.Ю. Мелкумян, О.С. Коваль 

Використання робототехийки для обстеження шахти шШсля обвалу 

Проанализовано реальн! задачу, високоактуальн! для шдвищення безпеки у ватчизнявшй вуглевидобувй 
галуз1 промисловост! з погляду шдтримки грничорятувальних ро@т засобами 1нтелектуал1зовано! 
робототехнки. Розглянуто деяк! питання створення програмно-апаратно{ частини моделювання 1 
функщонування роботйв для обстеження завалив 1 аварлино-небезпечних длянок у шахтах. 


Г. Р5агепко, Ли.Рбагепко, С. МеКитуан, А. Кота! 

Тре АррНсайоп 01 Кобойс$ Гог шзресйоп ог Мше АЁег СоПарзе 

Те геа! 612-асвла] {азКз$ Юг Фе шсгеазе оё заРеёу ш дотезИс оЁ соа[ ш4изжу Нот рошё оЁ заррогё оЁ 
ште-гезсие \огк$ асШИез пиеПеса| тобойс$ \еге апа[у7те4. боте даезНоп$ ог Баг4- ап зоЙ\аге 
сгеайоп оЁ гобоЁ5 4ез1еп апа РапсНоште Юг Фе шзресНоп оЁ обзтасНоп$ ап4 етегоепсу-дапсегоий$ агеа$ 
ш пез аге сопз14еге4. 


Статья поступила в редакцию 29.06.2010. 
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